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应 用 于 机 器 人 路 径 规划 的 双向 时 效 A* 算 法 
高 民 东 ， 张 雅 妮 ， 朱 凌云 


(重庆 理工 大 学 计算 机 科学 与 工程 学 院 , 重庆 400054) 


摘 要: 针对 时 效 A* 算 法 为 了 大 幅 减 少 算法 时 间 ， 导致 路 径 规划 长 度 增加 和 路 径 锯 疮 过 多 的 问题 ,提出 一 种 改进 的 双 
向 时 效 A* 算 法 ， 该 方法 将 从 起 点 和 终点 同时 运行 时 效 A* 算 法 寻找 路 径 ， 并 采用 多 近邻 栅 格 距离 计算 方案 ; 同时 ， 根 
据 不 同 环境 地 图 对 传统 A* 算 法 、 时 效 A* 算 法 和 双向 时 效 A*+ 算 法 运行 结果 进行 对 比 研究 及 分 析 ; 最 后 ， 制 定 算 法 时 
间 、 路 径 长 度 两 个 指标 来 评判 算法 的 优 为 。 实 验 结果 显示 ， 双 向 时 效 A* 算 法 相对 于 传统 A* 算 法 ， 算法 时 间 最 大 减少 
76.8%， 相 对 于 时 效 A* 算 法 ， 时 间 最 大 减少 55.4%， 并 解决 了 时 效 A* 算 法 规划 路 径 距 离 增 加 、 路 径 不 够 平滑 的 问题 。 
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Bidirectional time-efficient A* algorithm for robot path planning 


Gao Mindong, Zhang Yani, Zhu Lingyun’ 
(College of Computer Science & Engineering, Chongqing University of Technology, Chongqing 400054, China) 


Abstract: As for the Time-Efficient A* algorithm significantly reduces the algorithm time, lead to the problem of increase path 
planning length and path sawtooth. This paper proposed an improved Bidirectional Time-Efficient A* Algorithm, which will run 
the A* algorithm from the start and the end point to find the path and apply the multiple neighbor grid distance computation 
scheme. At the same time, according to different environment map, this paper compared and analyzed the A* algorithm, Time- 
Efficient A* algorithm and Bidirectional Time-Efficient A* algorithm. Finally, the index of algorithm time and path length will 


be chosen as two indicators to evaluate the merits and demerits of the algorithm. Experimental results show that compared with 


with traditional A* algorithm, the Bidirectional Time-Efficient A* decreases the time of the algorithm by 76.8% at the maximum, 
and reduces the maximum time by 55.4% compared with Time-efficient A* algorithm. It also solves the problem that the path 
distance of the Time-Efficient A* algorithm is augmented and the path is not smooth enough. 


Key Words: path planning; heuristic algorithm; time-efficient A* algorithm 


a 蜂 机 制 对 传统 人 工蜂 群 算法 进行 改进 ， 并 将 其 应 用 于 指 路 标志 
一 系统 中 中 ]。 
路 径 规划 技术 是 机 器 人 研究 的 一 个 重要 领域 ， 是 实现 轮 式 在 全 局 静态 路 径 规划 算法 中 , 因为 A* 算 法 的 成 熟 性 及 其 稳 


机 器 人 自主 定位 与 导航 的 关键 技术 之 一 。 路 径 规划 主要 任务 是 。 定性 ， 诸 多 学 者 对 A 算法 进行 了 多 种 改进 研究 : Sariff 等 人 曾 
使 机 器 人 能 够 安全 避 开 各 种 环境 中 的 障碍 物 ， 并 以 最 短 且 最 优 对 不 同 的 可 视图 法 与 A 算法 结合 后 的 算法 进行 对 比 研究 , 并 进 
的 路 径 到 达 所 指定 的 终点 。 路 径 规 划 技 术 根 据 环 卉 的 已 知 程度 。” 行 综述 性 分 析 外 ， 针 对 地 图 构建 方面 的 改进 ， Wang 等 人 对 路 
J 以 分 为 基于 模型 的 全 局 路 径 规 划 和 基于 传感器 的 局 部 路 径 规 。 径 规 划 在 城市 地 图 中 进行 应 用 研究 ,提出 基于 A’ 算法 的 分 层 A* 
划 ， 根 据 机 器 人 周围 环境 是 否 变 化 可 分 为 静态 路 径 规划 和 动态 。 算法 ， 该 算法 通过 对 城市 地 图 进行 分 层 处 理 ， 然 后 对 不 同 层次 
路 径 规划 中， 在 动态 路 径 规 划 研 究 中 ， 人 工 势 场 法 具有 同时 处 ” ”地 图 进行 A" 算 法 路 径 规划 ， 有 效 的 较 少 了 算法 的 运行 时 间 口 ; 
理 静 态 、 动 态 环 境 的 优点 ， 但 在 路 径 规划 过 程 中 容易 陷入 局 部 。 Lv 等 人 提出 以 拓扑 模型 方式 建立 地 图 ， 并 以 A’* 算 法 来 解决 自 
最 小 值 ， 目 前 已 有 很 多 相关 领域 专家 针对 此 问题 展开 了 广泛 的 。 主 地 面 车 辆 的 路 径 规 划 问 题 。 该 方法 解决 了 多 个 自主 车 辆 路 径 
研究 ， 如 将 机 器 人 相对 加 速度 引入 引力 势 场 函数 的 思想 中， 智 。” 规划 的 问题 ， 并 且 稳 定性 较 高 外 ， 李 冲 等 人 提出 了 一 种 新 的 单 
能 仿生 路 径 规划 具有 搜索 快 、 参 数 少 , 易于 实现 的 优点 , 郑 健 ， 边 和 矩形 扩展 A 算法 ， 该 算法 采用 受 迫 扩展 规则 ， 用 单条 公共 边 
黄 敏 等 人 曾 通过 引入 遗传 交叉 因子 、 精 英 保 留 策略 和 动态 侦查 取代 相 邻 矩形 的 两 条 重复 边 来 提高 算法 效率 四。 刘 大 瑞 等 人 基 
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， 该 算法 通过 采用 


算法 的 近邻 搜索 次 数 , 从 而 达 
增加 了 规划 路 径 的 长 度 ， 且 路 径 
继续 进行 改进 ， 首 先 ， 通 过 在 起 
使 得 路 径 搜 索 更 快 ， 算 法 效率 
其 次 ， 在 解决 路 径 不 够 平滑 问题 时 ， 从 辛 烃 ， 深 
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文 针对 对 
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使 路 径 规划 适 / 


以 及 Fernandes 等 人 
3 可 多 边 形 


析 ， 


1 ”时 效 A' 算 法 


0 中 研究 新 的 近邻 搜索 矩阵 改进 思路 ， 采 用 
利索 方案 来 蔡 换 原 8 近邻 搜索 方案 2; 
不 境地 图 对 三 种 路 径 规划 算法 


最 后 ， 本 


真实 验 结果 


进行 仿 


结果 显示 ， 该 方案 极 大 的 改善 了 时 效 A 算法 因 减 
少 算法 运行 时 间 而 导致 路 径 长 度 增加 以 及 路 径 不 够 平滑 的 问题 。 


传统 A 算法 采用 启发 式 函 数 路 径 规划 


从 起 点 开始 


测 ， 直 到 检测 范围 到 达 终 点 为 止 


， 检 测 当前 栅 格 周围 
取 周 围 八 个 近邻 栅 格 7(n) 值 最 


八 个 近邻 


思路 ， 其 主要 号 3 
格 的 f(n) 值 ， 


we 
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小 的 机 


法 有 很 多 


统 A’* 算 法 采 


公式 如 下 


f (n)= 
其 中 : g(n) 是 当前 栅 格 到 第 n 个 n 近邻 
是 第 n 个 近邻 栅 格 到 终点 的 距离 耗费 。 书 


所 示 : 


上 。 其 中 


8(n) +h(n) 


格 为 下 
， 了 (n) 值 的 计算 公式 如 下 : 


格 的 距离 耗费 ， 
格 之 间 的 距离 计算 方 
种 ， 如 欧 氏 距离 、 马 氏 距离 和 曼哈顿 距离 等 。 


用 欧式 距离 计算 8(n) 和 h(n) 的 值 ， 


一 个 ,继续 进行 检 
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h(n) 
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数 f(m) 1 
邻 栅 格 计算 步 又。 时 
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a) 输 入 阶段 ， 主 要 输入 机 器 人 的 运行 环境 地 图 和 机 器 人 的 


起 点 、 终 


制 位 图 ， 其 黑色 区 域 
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点 。 运 行 
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， 则 意味 这 接近 条 件 满足 ， 然 后 执行 A 算 法， 否则 继 


阶段 。 
o] 斜 率 检测 阶段 ， 该 阶段 将 会 


则 投射 到 该 目 


否 大 于 或 小 于 统一 值 来 投射 下 一 目标 点 到 但 


dj) 转换 阶段 ， 当 目标 点 5 临近 障碍 物 后 ， 标 记 


以 起 点 和 下 一 目标 点 为 终点 
并 与 起 点 至 终点 计算 的 初始 斜率 进行 比较 ， 如 果 斜 
标点 ， 如 果 和 斜率 不 统一 ， 则 根据 斜率 是 


E 意 角度 。 


标点 为 


ChinaXi : 
高 民 东 ， 等 : 应 用 于 机 器 人 路 径 规划 的 双向 时 效 A* 算 法 


SwitchS ， 同 时 将 Switchs 作为 新 的 起 点 ， 并 从 该 点 进行 A’* 算 法 
继续 规划 路 径 。 
6 结合 阶段 ， 当 A 算法 将 终点 加 入 关闭 列表 后 ， 即 可 得 出 
一 条 规划 路 径 , 结合 斜率 检测 得 出 的 路 径 结果 以 及 A-` 算 法 得 出 
的 路 径 结 果 即 可 获得 最 终 路 径 规划 结果 。 


2 ”双向 时 效 入 * 算 法 


双向 时 效 A* 算 法 流程 与 时 效 A* 算 法 大 臻 相同， 其 不 同 之 
处 在 于 对 时 效 A 算法 斜率 检测 阶段 和 转换 阶段 的 改进 ; 本 章 主 
要 讨论 本 文 改 进 算法 的 算法 流程 以 及 本 文 提 出 的 多 近邻 栅 格 改 
进 方案 。 
2.1 算法 近邻 栅 格 改进 
首先 针对 时 效 A* 算 法 中 的 近邻 搜索 和 矩阵 进行 改进 , 即 转换 
阶段 中 的 执行 的 A’ 算法 固定 8 个 近邻 栅 格 搜索 方式 改进 为 16、 
32 和 56 近邻 栅 格 搜索 方式 。 定 义 MM, 代表 n 个 近邻 搜索 矩阵 ， 
同时 ， 和 矩阵 值 中 的 元 素 MM, (x,y) 代表 第 x 行 ， 第 y 列 的 近 令 机 
格 , 矩阵 中 心 M,(x+1/2,y+1/2) 为 开启 列表 中 的 目标 点 , 根据 


以 上 定义 ， 可 以 得 出 原始 算法 的 8 近邻 栅 格 搜索 矩阵 为 
111 
M;=I10 1 (3) 
111| 
其 中 : 当 M(x,y)=1 代 表 该 机 格 为 需要 进行 距离 计算 的 近邻 顶 
格 且 存在 与 开始 列表 中 , 当 M(x,y)=0 代 表 该 栅 格 不 需要 进行 
距离 计算 ， 且 在 关闭 列表 中 。 
同 理 可 得 16 近邻 栅 格 搜索 矩阵 如 式 (4) 所 示 。 
0 .10 10| 
11111 
Mis=I0 10 10 (4) 
11111 
01010 


对 比 Ms 和 Ms 可 以 看 出 ,采用 Ms 作为 搜索 矩阵 的 路 径 规 
划算 法 具有 8 个 备 选 方向 ， 而 采用 Mis 作为 搜索 矩阵 的 路 径 规 
划算 法 具有 16 个 备 选 方向 ， 使 得 路 径 规划 方向 选择 更 加 多 样 
化 。 同 理 可 得 32 近邻 的 搜索 矩阵 Ma 和 56 近邻 的 搜索 矩阵 
M 


根据 以 上 公式 可 以 看 出 ， 多 近邻 搜索 矩阵 Mie 、 Ma 和 
Ms 比 传 统 算法 近邻 搜索 矩阵 Ms 拥有 更 多 的 备 选 方向 ， 同 时 
在 近邻 搜索 过 程 中 , 更 更 大 范围 的 进行 启发 式 函 数 的 遍历 计算 ， 
从 理论 上 不 仅 可 以 使 得 路 径 规 划 过 程 更 加 迅速 ， 还 能 减少 路 径 
规划 路 线 结果 的 锯齿 ， 使 其 更 加 平滑 。 

2.2 算法 改进 流程 

同时 效 A 算法 一 样 ,双向 时 效 A 算法 同样 包含 五 个 阶段 : 
输入 阶段 、 接 近 检 测 阶 段 、 斜 率 检测 阶段 、 转 换 阶 段 、 结 合 阶 
段 。 但 在 斜率 检测 阶段 ,双向 时 效 A* 算 法 是 从 起 点 和 终点 同时 
进行 斜率 检测 ， 从 而 在 原 算 法 基础 上 再 次 减少 了 算法 的 遍历 次 
数 以 及 算法 运行 时 间 。 其 算法 流程 如 图 1 所 示 。 
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图 1 双向 时 效 A' 算 法 流程 图 
从 图 1 中 可 以 看 出 ， 在 斜率 检测 阶段 ， 算 法 首先 计算 起 点 
与 终点 的 初始 斜率 ， 然 后 同时 计算 并 比较 起 点 与 下 标点 斜 
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在 转换 阶段 ， 会 存在 两 个 目标 点 临近 障碍 物 ， 一 个 是 从 起 
标点 A， 另 一 个 是 从 终点 投射 的 目标 点 BB， 然后 标 
点 4 为 新 的 起 点 SwitchA4 ， 目 标点 B 为 新 的 终点 SwitchB ， 
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并 以 SwitrchA 和 SwitchB 为 输入 变量 转 而 执行 A* 路 径 规划 算法 。 
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结果 进行 对 比分 析 ; 
并 结合 其 余 两 


口 口 


运行 时 间 等 实验 


验 结果 
以 =- 吕 丰 ， 


径 规划 结果 对 比分 析 


先 对 三 种 算法 在 不 同 地 


区 


环境 下 的 路 径 规 划 结 果 进 行 实 


验 与 分 证 


Tf, 本 文 设 


五 种 地 


区 


区 


环境 ,其 中 前 三 种 为 小 地 图 环境 ， 


™ 


包括 单 障碍 物 、 多 障碍 物 和 圆 形 障碍 物 等 情况 ， 其 大 小 为 100 


> 


X100 dpi; 后 两 


中 为 大 地 图 环境 ， 包 括 圆 形 障碍 物 和 混合 障碍 


物 情况 ， 其 大 小 为 500X500 dpi。 设 置 机 器 人 起 点 为 [10, 10]， 


率 ， 终 点 与 下 一 目标 点 与 斜率 与 初始 斜率 的 大 小 ， 如 果 和 斜率 统 ”小 地 图 环境 终点 为 [95, 95]， 大 地 图 环境 终点 为 [450, 450]。 其 路 
一 ， 则 分 别 投射 至 下 一 目标 点 ， 如 果 不 统一 ， 则 根据 斜率 是 否 ” 径 规划 实验 结果 如 图 2 所 示 。 
下 #7 . 
60 60 及 60 
房间 距离 Y 10 20 30 a 70 80 90 100 10 20 30 人 We 70 80 90 100 
地 图 1 地 图 2 地 图 3 
OO 起 点 
人 @ 从 点 
1 ~ 一 一 Astar 路 径 
二 so0 
50 100 150 2 350 400 450 500 50 100 150 ee 350 400 450 500 
地 图 4 地 图 5 
图 2 不 同 算法 路 径 规划 结果 图 
图 2 中 显示 了 传统 A 算法 、 时 效 A" 算 法 、 双 向 时 效 A 算 了 不 必要 的 行走 路 径 ， 图 2(b) 中 改进 算法 规划 路 径 与 其 余 两 种 
法 的 路 径 规划 对 比 结果 ， 在 小 地 图 环境 下 ， 图 2(a)(c) 的 改进 算 。 算法 规划 路 径 略 优 ， 且 锯齿 过 多 。 在 大 地 图 环境 下 ， 图 2(d) 的 
法 规划 路 径 结 果 比 其 余 两 种 算法 规划 路 径 结果 更 优越 ， 并 减少 ”改进 算法 规划 路 径 比 其 余 两 种 算法 更 优越 ， 且 弯 折 较 少 ， 虽 然 


录用 稿 


时 效 A’ 算 法 规划 路 径 亦 合理 ， 


适合 机 器 人 行走 ;图 


2(e) 的 改进 算法 
的 转折 点 ， 使 得 比 其 余 两 种 算法 规 蕊 


图 2 中 改进 算法 路 径 在 大 多 数 地 


但 规划 路 径 距 离 障碍 物 过 近 ， 不 
路 径 并 避 开 了 方形 障碍 物 


更 加 合理 、 有 效 ， 但 是 其 锯齿 仍然 过 多 ， 故 通过 第 二 步 改 进 ， 
即 蔡 换 原 搜索 矩阵 Ms 为 近邻 搜索 矩阵 上 4、 M ,, 和 Ms; 9 
实验 结果 如 图 3 和 4 所 示 。 
8 近邻 56 近 邻 
O 起 点 
20 20 口 终点 
x x 路 径 
名 40 条 40 
四 加 
长 60 里 60 
80 80 
100 100 
20 40 60 80 100 20 40 60 80 100 
房间 距离 Y 房间 距离 Y 
8 近邻 56 近 邻 
20 20 
x x 
研 40 全 40 
加 加 
攻 60 长 60 
80 80 
100 100 
20 40 60 80 100 20 40 60 80 100 
房间 距离 Y 房间 距离 Y 
8 近邻 56 近 邻 
20 20 
x x 
个 40 地 40 
EE EE 
后 60 长 60 
80 80 
100 100 
20 40 60 80 100 20 40 60 80 100 
房间 距离 Y 房间 距离 Y 
图 3 多 近邻 路 径 规 划 结 果 对 比 〈 小 地 图 环境 ) 
8 近邻 56 近 邻 
100 
准 200 
Ea 
区 
全 300 
400 
500 
100 200 300 400 500 100 200 300 400 500 
房间 距离 Y 房间 距离 Y 
8 近邻 56 近 邻 
100 
准 200 益 
四 去 
区 巨 
臣 300 起 
400 
500 
100 200 300 400 500 100 200 300 400 500 
房间 距离 Y 房间 距离 Y 
图 4 多 近邻 路 径 规 划 结 果 对 比 〈 大 地 图 环境 ) 
因 篇 幅 有 限 ， 图 3 和 4 仅 对 比 双 向 时 效 A’* 算 法 (8 近邻 ) 


和 双向 时 效 A* 算 法 (56 近邻 ) 的 路 径 规划 


结果 。 从 图 


3 和 4 可 


以 看 出 , 经 过 替换 多 近邻 搜索 矩阵 后 的 双向 时 效 A* 算 法 比 原 双 


民 东 ， 等 : 


至 


向 时 效 A` 算 法 路 径 更 加 平滑 ,无 过 多 弯 折 ， 并 有 效 的 避 


碍 物 ， 在 图 3 的 地 图 二 环境 中 ， 


本 日 工 
[ 日 干 | 


应 用 于 机 器 人 路 经 规划 ns A* 算 法 


了 障 
多 近邻 改进 后 的 算法 重新 规划 


处 一 条 与 原 算法 完全 不 同 的 更 优 路 径 ， 亦 达到 了 路 径 平 滑 的 要 


求 。 综 上 所 述 
种 算法 更 


万 更 平滑 的 路 径 结 果 


， 本 文 改 进 算法 可 以 完整 的 规划 出 一 条 


比 其 余 两 


3.2 ”算法 效率 与 路 径 长 度 对 比分 析 


本 文 以 算法 效率 、 路 径 长 度 


为 评价 指标 来 判定 本 文 改进 算 


法 的 路 径 规划 结果 是 否 达 
三 种 算法 的 对 比 实验 ， 


不 。 


小 地 图 情况 


大 到 最 优 最 短路 径 的 要 求 。 通 过 上 节 对 
可 以 得 出 传统 A 算法、 时 效 A 算法 、 双 
向 时 效 A 算法 的 算法 效率 以 及 路 径 规划 长 度 结果 , 如 医 


5~7 所 


大 地 图 情况 
国 Astar 算 法 i 


4 0 | 国 时 效 Astar 算 法 
国 双 向 时 效 Astar 算 法 


算法 时 间 
S 8 


a 
© 


地 图 一 地 图 二 地 图 三 


地 图 四 “地 图 五 


5 算法 效率 对 比 结果 


图 5 显示 了 三 个 不 同 算法 的 运行 时 间 对 比 ,可 以 明显 看 出 ， 


传统 A* 算 法 规划 路 径 时 间 过 长 
上 明显 减少 了 算法 运行 时 间 ， 


， 而 时 效 A 算法 在 原 算法 基础 


本 文 改进 算法 在 大 多 数 地 图 情况 


下 提升 了 算法 效率 ， 但 在 地 图 五 


情况 下 ， 算 法 运行 时 间 较 时 效 


A 算法 高 。 


上 
十 况 


小 地 图 


大 地 图 情况 


地 图 一 地 图 二 地 图 三 


通过 多 近邻 搜索 矩阵 可 以 使 


少 算法 循环 次 数 ， 从 而 减少 算法 


实验 结果 对 比如 图 


6 所 示 。 


地 图 由 地 图 五 


图 6 多 近邻 算法 效率 对 比 结果 


一 次 遍历 栅 格 数 增加 而 减 


运行 时 间 ， 同 时 多 近邻 搜索 矩 


阵 提 供 更 多 的 路 径 备 选 方向 ， 使 得 路 径 更 加 平滑 ， 针 对 改进 后 
的 双向 时 效 A’ 算 法 进行 蔡 换 多 近 


邻 搜索 矩阵 实验 , 其 算法 效率 


从 图 6 中 可 以 看 出 , 替换 多 近邻 搜索 矩阵 后 的 双向 时 效 A* 


算法 比 前 面 几 种 算法 效率 更 高 ; 
双向 时 效 A* 算 法 要 比 56 ; 
高 ， 但 算法 i 


在 某 些 地 图 


环境 下 ，32 近邻 的 


近邻 的 双向 时 效 A* 算 法 的 算法 效率 略 
运行 时 间 总 体 呈 下 降 趋势 ,在 地 图 五 中 ， 多 近邻 改 


进 后 的 双向 时 效 A” 


运行 时 间 更 少 。 


算法 效率 得 到 了 明显 提高 ， 


比 时 效 A 算法 
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小 地 图 情况 


hinaXiv 合 作 期 于 


等 : 应 用 于 机 器 人 路 径 规划 的 双向 时 效 A* 算 法 


可 


民 东 ， 


决 了 时 效 A’ 算 法 为 了 提高 算法 效率 而 增加 路 径 规划 长 度 的 问 


减少 传统 A 算法 的 路 径 规划 长 度 。 


题 ， 并 小 幅 
3.3 小 结 


种 不 同 地 图 环境 下 ， 以 路 径 规划 结果 、 
平价 指标 进行 了 仿 


二 和 


四 
信 0o 


对 比 ， 
百分比 。 


率 上 最 少 提 升 了 14.4%， 最 大 提升 了 55.4%; 在 规划 路 径 结 果 


本 节 对 传统 A* 算 法 、 时 效 A* 算 法 和 双向 时 效 A* 算 法 在 五 
算法 效率 及 路 径 长 度 为 
实验 与 结果 分 析 ， 最 终 得 出 表 1 的 实验 结 
表 1 中 列举 了 三 种 不 同 算法 的 算法 效率 以 及 路 径 长 度 结果 
计算 了 其 算法 效率 减少 百分比 以 及 路 径 规划 结果 减少 


十 


从 表 1 中 可 以 看 出 ， 本 文 改 进 算法 比 原 作者 算法 在 算法 效 


ee WA 
度 。 综 上 所 述 ,， 多 近邻 改进 后 的 双向 时 效 A* 算 法 在 规划 路 径 过 
从 图 7 可 以 看 出 ， 时 效 A’* 算 法 在 减少 传统 A" 算 法 运行 时 ， 程 中 ， 相 对 于 其 余 两 种 算法 ， 在 保证 路 径 最 优 的 情况 下 ， 不 仅 
间 的 过 程 中 ， 也 会 导致 其 路 径 长 度 的 增加 ， 本 文 改进 算法 虽然 。 有 效 、 合理 的 减少 了 算法 运行 时 间 , 而 且 解 决 了 时 效 A* 算 法 的 
在 某 些 地 图 情况 下 , 也 会 在 时 效 A* 算 法 规划 路 径 长 度 结果 上 进 ” ”路径 长 度 增加 问题 ， 在 蔡 换 多 近邻 矩阵 后 的 算法 路 径 规 划 结 果 
一 步 增加 ， 但 进 过 蔡 换 多 近邻 搜索 矩阵 后 的 双向 时 效 A* 算 法 ， 有效 减少 了 路 径 的 弯 折 过 多 的 问题 ， 路 径 平滑 可 靠 ， 使 得 改进 
其 路 径 规 划 长 度 结果 呈 下 降 并 逐步 稳定 趋势 ， 最 终结 果 表 明 ， 后 的 双向 时 效 A* 算 法 在 路 径 规划 中 的 应 用 更 加 具有 可 靠 性 和 
本 文 改进 算法 不 仅 在 算法 效率 上 比 时 效 A’* 算 法 更 高 , 而 且 还 解 ”稳定 性 。 
表 1 算法 路 径 长 度 对 比 结 
二 传统 Astar 算法 时 效 Astar 算法 双向 时 效 Astar 算法 结果 对 比 
算法 效率 /s ”路 径 长 度 /mm 算法 效率 /s ”路 径 长 度 /m 算法 效率 /s ”路 径 长 度 /mm 减少 时 间 ”减少 长 度 
1 0.121 1.267 0.053 1.267 0.028 1.244 46.8% 1.8% 
人 2 0.233 1.442 0.183 1.442 0.110 1.377 40.1% 4.5% 
3 0.164 1.378 0.115 1.394 0.010 1.345 55.4% 3.5% 
4 27.949 7.101 18.636 7.134 9.950 6.888 46.6% 3.5% 
5 44.130 7.814 32.952 7.884 28.195 7.473 14.4% 5.2% 
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